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Abstract 

Probabilistic sampling-based algorithms, such as the probabilistic roadmap (PRM) and the rapidly-exploring random tree 
(RRT) algorithms, represent one of the most successful approaches to robotic motion planning, due to their strong theoretical 
properties (in terms of probabilistic completeness or even asymptotic optimality) and remarkable practical performance. 
Such algorithms are probabilistic in that they compute a path by connecting independently and identically distributed 
(i.i.d.) random points in the configuration space. Their randomization aspect, however, makes several tasks challenging, 
including certification for safety-critical applications and use of offline computation to improve real-time execution. Hence, 
an important open question is whether similar (or better) theoretical guarantees and practical performance could be obtained 
by considering deterministic, as opposed to random sampling sequences. The objective of this paper is to provide a rigorous 
answer to this question. Specifically, we first show that PRM, for a certain selection of tuning parameters and deterministic 
low-dispersion sampling sequences, is deterministically asymptotically optimal, i.e., it returns a path whose cost converges 
deterministically to the optimal one as the number of points goes to infinity. Second, we characterize the convergence rate, 
and we find that the factor of sub-optimality can be very explicitly upper-bounded in terms of the f 2 -dispersion of the 
sampling sequence and the connection radius of PRM. Third, we show that an asymptotically optimal version of PRM 
exists with computational and space complexity arbitrarily close to 0{n) (the theoretical lower bound), where n is the 
number of points in the sequence. This is in stark contrast to the 0{n log n) complexity results for existing asymptotically- 
optimal probabilistic planners. Fourth, we show that our theoretical results and insights extend to other batch-processing 
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algorithms such as FMT*, to non-uniform sampling strategies, to fc-nearest-neighbor implementations, and to differentially- 
constrained problems. Finally, through numerical experiments, we show that planning with deterministic low-dispersion 
sampling generally provides superior performance in terms of path cost and success rate. 


1. Introduction 


Probabilistic sampling-based algorithms represent a particularly successful approach to robotic motion planning problems 
[Thrun et al.||2005l|Lavalle||2006| . The key idea behind probabilistic sampling-based algorithms is to avoid the explicit 
construction of the configuration space (which can be prohibitive in complex planning problems) and instead conduct a 
search that probabilistically probes the configuration space with independently and identically distributed (i.i.d.) random 
samples. This probing is enabled by a collision detection module, which the motion planning algorithm considers as 
a “black box" | |Lavalle| |2006| |. Examples, roughly in chronological order, include the probabilistic roadmap algorithm 
(PRM) [Kavraki et al.[|19^ , expansive space trees (EST) [Hsu et aL||1999| [Phillips et al.||2004[ , Lazy-PRM [Bohlin and] 
|Kavraki[|2000) , the rapidly exploring random trees algorithm (RRT) | |LaV alle and Kuffner||200 1 1 , sampling-based roadmap 
of trees (SRT) | Plaku et ak]|2005| , rapidly-exploring roadmap [Alterovitz et al. 20111, PRM* and RRT* |Karaman and 


Erazzoli 


201 1) , RRT^ I Arslan and Tsiotras 20131, and the fast marching tree algorithm (EMT*) | Janson et al. 20151. A 


central result is that these algorithms provide probabilistic completeness guarantees in the sense that the probability that 
the planner fails to return a solution, if one exists, decays to zero as the number of samples approaches infinity ||Barraquand| 


et al. 2000|. Recently, it has been proven that RRT*, PRM*, RRT^, and EMT* are asymptotically optimal, i.e., the cost 


of the returned solution converges almost surely to the optimum [Karaman and Erazzoli||20lT| [Arslan and Tsiotras [ [2013] 
[Janson et al.l|2015l . 

It is natural to wonder whether the theoretical guarantees and practical performance of sampling-based algorithms would 
hold if these algorithms were to be de-randomized, i.e., run on a deterministic, as opposed to random sampling sequence. 
This is an important question, as de-randomized planners would significantly simplify the certification process (as needed 
for safety-critical applications), enable the use of offline computation (particularly important for planning under differential 
constraints or in high-dimensional spaces—exactly the regime for which sampling-based planners are designed), and, in 
the case of lattice sequences, drastically simplify a number of operations (e.g., locating nearby samples). This question 
has received relatively little attention in the literature. Specifically, previous research j jBranicky et al. j [200l||La Valle et al.j 
|2004| [Hsu et ah] |2006[ has focused on the performance of de-randomized versions of sampling-based planners in terms 
of convergence to feasible paths. A number of deterministic variants of the PRM algorithm were shown to be resolution 
complete (i.e., provably converging to a feasible solution as n —oo) and, perhaps surprisingly, offer superior performance 
on an extensive set of numerical experiments j jBranicky et al.||2001||LaValle et al^|2004| . Prompted by these results, a 
number of deterministic low-dispersion, incremental sequences have been specifically tailored to motion planning problems 
j jYershova and LaVallej|T004j|Lindemann et al.j[2005] [Yershova et al.j|2010| . 

The results in j jBranicky et al.j [2001 [[La Valle et al.jj2004j [Hsu et al.j[2006| are restricted to convergence to feasible, as 
opposed to optimal paths. Several questions are still open. Are there advantages of i.i.d. sampling in terms of convergence 
to an optimal path? Can convergence rate guarantees for the case of deterministic sampling be provided, similar to what 
is done for probabilistic planners in j j Janson et al.j[2015) [Dobson et al.[j2015[ ? Eor a given number of samples, are there 
advantages in terms of computational and space complexity? The objective of this paper is to rigorously address these 
questions. Our focus is on the PRM algorithm. However, we show that similar results hold for many of the existing batch 
(i.e., not anytime) algorithms, including Lazy-PRM and EMT*. 

Statement of Contributions: The contributions of this paper are as follows. 


Deterministic asymptotic optimality of sampling-based planning: We show that the PRM algorithm is asymptotically 
optimal when run on deterministic sampling sequences in d dimensions whose f 2 -dispersion is upper-bounded by 
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7 n for some 7 G K>o (we refer to such sequences as deterministic low-dispersion sequences), and with a 
connection radius r„ € In other words, the cost of the solution computed over n samples converges 

deterministically to the optimum as n —>^ oo. As a comparison, the analogue result for the case of i.i.d. random 
sampling holds almost surely or in probability |Karaman and Frazzoli 2011 Janson et al.[ 2015| (as opposed to 
deterministically) and requires a connection radius 17 ((log(n)/n)^/‘^), i.e., bigger. 

Convergence rate: We show that, in the absence of obstacles, the factor of sub-optimality of PRM is upper-bounded by 
2Dn/ (r„ — 2Dn), where is the ^ 2 -dispersion of the sampling sequence. A slightly more sophisticated result holds 
for the obstacle-cluttered case. As a comparison, the analogue result for the case of i.i.d. sampling only holds in 
probability and is much more involved (and less interpretable) [Janson et al. 20151. Our results could be instrumental 
to the certification of sampling-based planners. 


Computational and space complexity: We prove that PRM, when run on a low-dispersion lattice, has computational 
and space complexity O(n^r^). As asymptotic optimality can be obtained using S there exists an 

asymptotically optimal version of PRM with computational and space complexity uj{n), where 0{n) represents the 
theoretical lower bound (as, at the very least, n operations need to be carried out to load samples into memory). As a 


comparison, the analogous complexity results for the case of i.i.d. sampling are of order 0{n log(n)) [Karaman and 
|Frazzolil|201 1| . 


Extensions: We extend the contributions in all three of the preceding categories to much broader settings. Specifically, we 
find that many of the results that hold for PRM run on a low-dispersion lattice hold either exactly or approximately for 
fc-nearest-neighbor algorithms, for other batch-processing algorithms such as FMT*, for non-lattice low-dispersion 
sampling such as the Halton sequence, for non-uniform sampling, and for kinodynamic planning. 


Experimental performance: Finally, we compare performance (in terms of path cost and success rates) of deterministic 
low-dispersion sampling versus i.i.d. sampling on a variety of test cases ranging from two to eight dimensions and 
including geometric, kinematic chain, and kinodynamic planning problems. In all our examples, for a given number 
of samples, deterministic low-dispersion sampling performs no worse and sometimes substantially better than i.i.d. 
sampling (this is not even accounting for the potential significant speed-ups in runtime, e.g., due to fast nearest-neighbor 
indexing). 


The key insight behind our theoretical results (e.g., smaller required connection radius, better complexity, etc.) is the 
factor difference in dispersion between deterministic low-dispersion sequences versus i.i.d. sequences, namely 
versus 0((log |Deheuvels 


1983 


Niederreiter 


19921. Interestingly, the same 0{n dispersion can be 


achieved with non-i.i.d. random sequences, e.g., randomly rotated and offset lattices. As we will show, these sequences 
enjoy the same deterministic performance guarantees of deterministic low-dispersion sequences and retain many of the 
benefits of deterministic sampling (e.g., fast nearest-neighbor indexing). Additionally, their “controlled" randomness may 
allow them to address some potential issues with deterministic sequences (in particular lattices), e.g., avoiding axis- 
alignment issues in which entire rows of samples may become infeasible due to alignment along an obstacle boundary. 
In this perspective, achieving deterministic guarantees is really a matter of i.i.d. sampling versus non-i.i.d. low-dispersion 
sampling (with deterministic sampling as a prominent case), as opposed to random versus deterministic. Collectively, 
our results, complementing and corroborating those in [Branicky et al. [ [200l||La Valle et al.]|2004| , strongly suggest that 
both the study and application of sampling-based algorithms should adopt non-i.i.d. low-dispersion sampling. From a 
different viewpoint, our results provide a theoretical bridge between sampling-based algorithms with i.i.d. sampling and 


'For /, g : N —>■ R, we say / S 0{g) if there exists no S N and k S R>o such that |/(n)| < k |g(n)| for all n > no- We say / £ ^(g) if there 
exists no G N and k G R>o such that |/(n)| > k |g(n)| for all n > ng. Finally, we say / G i^{g) if lim„_>oo /(ti)/s(n) = oo. 
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non-sampling-based algorithms on regular grids (e.g., D* | Stentz 1995| and related kinodynamic variants | Pivtoraiko et al. 
[20091 ). 


Organization: This paper is stmctured as follows. In Section [^ we provide a review of known concepts from low- 
dispersion sampling, with a focus on f 2 -dispersion. In Sectionj^we formally define the optimal path planning problem. In 
Sectionj^we present our three main theoretical results for planning with low-dispersion sequences: asymptotic optimality, 
convergence rate, and computational and space complexity. In Sectionj^we extend the results from Sectionl^to other batch¬ 
processing algorithms, non-uniform sampling, and kinodynamic motion planning. In Section [^ we present results from 
numerical experiments supporting our statements. Finally, in SectionjT] we draw some conclusions and discuss directions 
for future work. 


2. Background 

A key characteristic of any set of points on a finite domain is its £ 2 -dispersion. This concept will be particularly useful in 
elucidating the advantages of deterministic sampling over i.i.d. sampling. As such, in this section we review some relevant 
properties and results on the £ 2 -dispersion. 

Definition 1 (£ 2 -dispersion). For a finite, nonempty set S of points contained in a d-dimensional compact Euclidean 
subspace X with positive Lebesgue measure, its £ 2 -£//spers/on D{S) is defined as 


D{S) := sup min ||s — a ;||2 = sup {r > 0 : 3x G X with B{x, r) n S' = 0} , (j) 

xex se-S 


where B(x, r) is the open ball of radius r centered at x. 


Intuitively, the £ 2 -dispersion quantifies how well a space is covered by a set of points S in terms of the largest open 
Euclidean ball that touches none of the points. The quantity D{S) is important in the analysis of path optimality as an 
optimal path may pass through an empty ball of radius D{S). Hence, D{S) bounds how closely any path tracing through 
points in S can possibly approximate that optimal path. 

The £2 -dispersion of a set of deterministic or random points is often hard to compute, but luckily it can be bounded by the 
more-analytically-tractable £oo-dispersion. The £oo-dispersion is defined by simply replacing the £ 2 -norm in equation ([T]i by 
the £oo-norm, or max-norm. The £ 00 -dispersion of a set S, which we will denote by 13 00 (S'), is related to the £ 2 -dispersion 
in d dimensions by | Niederreiter 1992| , 

D^{S)<D{S)<VdD^{S), 


which allows us to bound D{S) when Dao{S) is easier to compute. In particular, an important result due to [Deheuvels 


1983) is that the £ 00 -dispersion of n independent uniformly sampled points on [0,1]^^ is 0((log(n)/n)^/'^) with probability 
1. Corollary to this is that the £ 2 -dispersion is also 0((log(n)/n)^/'^) with probability 1. 

Remarkably, there are deterministic sequences with £ 2 -dispersions of order an improvement by a factor 

log(n)^/‘^. (Strictly speaking, one should distinguish point sets, where the number of points is specified in advance, from 
sequences [La Valle et al.||2004) —in this paper we will simply refer to both as “sequences.”) For instance, the Sukharev 
sequence [Sukharev 1971) , whereby [0, is gridded into n = hypercubes and their centers are taken as the sampled 
points, can easily be shown to have £ 2 -dispersion of (v/d/2) for n = k'^ points. As we will see in Section]^ the 

use of sample sequences with lower £ 2 -dispersions confers on PRM a number of beneficial properties, thus justifying the 
use of certain deterministic sequences instead of i.i.d. ones. In the remainder of the paper, we will refer to sequences with 
£ 2 -dispersion of order as low-dispersion sequences. A natural question to ask is whether we can use a sequence 

that minimizes the £ 2 -dispersion. Unfortunately, such an optimal sequence is only known for d = 2, in which case it is 
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represented by the centers of the equilateral triangle tiling | |Lavalle| |2006| . In this paper, we will focus on the Sukharev 
||Sukhare\^|197H and Halton sequences ||Halton|[1960|, except in two dimensions when we will consider the triangular 


lattice as well, though there are many other deterministic sequences with £ 2 -dispersion of order 0{n see | Yershova 


and LaValle 2004 Lindemann et al. 2005 Yershova et al. 20101 for other examples. 


3. Problem Statement 

The problem formulation follows that in jJanson et al. 2015) very closely. Let X = [0, 1]“^ be the configuration space, 
where d G N. Let A’obs be a closed set representing the obstacles, and let Tfree = cl{X \ A’obs) be the obstacle-free space, 
where cl( ) denotes the closure of a set. The initial condition is Xmit € ‘^bee, and the goal region is A’goai C Tfree- A specific 
path planning problemis characterized by a triplet (Afree, a^init) A’goai). Afunction cr : [0,1] —>■ is apaf/i if it is continuous 
and has bounded variation. If cr(T) € Afree for all r S [0, 1], tr is said to be collision-free. Finally, if a is collision-free, 
(t(0) = Xinit, and cr(l) G c/(A’goai), then a is said to be a feasible path for the planning problem (Afree, a;init, A’goai). 

The goal region A’goai is said to be regular if there exists ^ > 0 such that Vy G clA’goai, there exists z G Xg^ai with 
B{z] C A’goai and y G dB{z\ (the notation dX denotes the boundary of set X). Intuitively, a regular goal region is a 
smooth set with a boundary that has bounded curvature. Regularity is a technical condition we will use in our results, but is 
in fact quite weak, as nearly any goal region can be well-approximated by a regular goal region. Furthermore, we will say 
A’goai is ^-regular if A’goai is regular for the parameter Denote the set of all paths by E. A cost function for the planning 
problem (A’free, aiinit, A’goai) is a function c : E —>^ ]R>o; in this paper we will focus on the arc length function. The is then 
defined as follows: 


Optimal path planning problem: Given a path planning problem (A’free, a::init) A’goai) with an arc length cost function 
c : E —>■ K>o, find a feasible path cr* such that c{a*) = min{c(cr) : a is feasible}. If no such path exists, report failure. 


A path planning problem can be arbitrarily difficult if the solution traces through a narrow corridor, which motivates the 
standard notion of path clearance | Karaman and Frazzoli 201 1| . For a given 5 > 0, define the 5-interior of A’free as the set 
of all configurations that are at least a distance S from A’obs. Then a path is said to have strong 5-clearance if it lies entirely 
inside the 5-interior of A’free- Further, a path planning problem with optimal path cost c* is called 5-robustly feasible if there 
exists a strictly positive sequence 5„ —>■ 0, and a sequence {an}f=i of feasible paths such that lim„_>.oo c(tT„) = c* and 
for all n S N, has strong 5„-clearance, (j„(1) G SA’goai, and CT„(r) ^ A’goai for all r G (0,1). 

Lastly, in this paper we will be considering a generic form of the PRM algorithm. That is, denote by gPRM (for generic 
PRM) the algorithm given by Algorithm)^ The function SampleFree(n) is a function that returns a set of n S N points 
in A’free- Given a set of samples V, a sample v G V, and a positive number r, Near(y, v, r) is a function that returns the 
set of samples {m S 14 : ||u — u ||2 < r}. Given two samples u,v G V, CollisionFree(u,u) denotes the boolean 
function which is true if and only if the line joining u and v does not intersect an obstacle. Given a graph [V^ E), where the 
node set V contains ccinit and E is the edge set, ShortestPath(a:init, V} E) is a function returning a shortest path from 
Xinit to A’goai in the graph (V, E) (if one exists, otherwise it reports failure). Deliberately, we do not specify the definition 
of SampleFree and have left r„ unspecified, thus allowing for any sequence of points—deterministic or random—to be 
used, with any connection radius. These “tuning" choices will be studied in Section]^ We want to clarify that we are in no 
way proposing a new algorithm, but just defining an umbrella term for the PRM class of algorithms which includes, for 
instance, sPRM and PRM* as defined in QKaraman and Frazzoli] |20lT|. 
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Algorithm 1 gPRM Algorithm 

1 V 4 - {xinit} U SampleFree(n); i? ^ 0 

2 for all x s y do 

3 ^near ^ Near(t/\{r;}, v, r„) 

4 tor X e Xnear dO 

5 if CollisionFree(f, x) then 

6 i? •(—i? U {(x, x)} U {(x, x)} 

7 end if 

8 end for 

9 end for 

10 return ShortestPath(xinit, 1^, i?) 


4. Theoretical Results 

In this section we present our main theoretical results. We begin by proving that gPRMon low-dispersion sequences is 
asymptotically optimal, in the deterministic sense, for connection radius S Previous work has required r„ 

to be at least f 2 ((log(n)/n)^/‘^) for asymptotic optimality. 

Theorem 1 (Asymptotic optimality with deterministic sampling). Let (A^free, Xinn, -^goai) be a 5-wbustly feasible path 
planning problem in d dimensions, with (5 > 0 and Xgoai ^-regular. Let c* denote the arc length of an optimal path a*, 
and let Cn denote the arc length of the path returned by gPRM(or oo if gPRM returns failure) with n vertices whose 
(. 2 -dispersion is D(V) using a radius Tn- Then if D{V) < for some 7 G K and 

00 , ( 2 ) 


then lim„ 


Cn — C 


Proof. Fix e > 0. By the i5-robust feasibility of the problem, there exists a CTe such that c(cr£) < (1 -f e/3)c* and has 
strong iJe-clearance for some 6^ > 0, see Figure 1(a) Let be a sequence such that < r„, rfl'^Rn —> 00 , and 



(b) 


Fig. 1. Figure [T(a)] Illustration in 2D of a,, as the shortest strongly Jj-robust feasible path, as compared to the optimal path a*, as used 
in the proof of Theorem[^ Figure [T(b)l Illustration in 2D of the construction of Bi,..., Bm „+2 in the proof of Theorem[T] 



Rn — 1 - 0, guaranteeing that there exists a no G N such that for all n > no, 

(4 -F 6 /e) 7 n“^/‘^ < Rn < min{(5E, c*e/ 6 }. 


(3) 
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For any n > uq, construct the closed balls such that ^ has radius and has center given by tracing a 

distance (ii„ — from xq along (this distance is positive by equation Q) until (ii„ — > c(tTe). 

This will generate M„ = [c(cre)/(i?„ — 2777 ,“^/'^)] balls. Define i3„ m„+i to also have radius 771 “^/'^ but center given by 
the point where meets -Tgoai- Finally, define i?n,M „+2 to have radius 771 “^/'^ and center defined by extending the center 
of into -Tgoai by a distance i?„ — in the direction perpendicular to dXgoah Note that by equation Q, 

Bn,Mn +2 C Xgoai- See Figure [T(b)] for an illustration. 

Since the dispersion matches the radii of all the Bn^m, each m has at least one sampled point within it. Label these 
points xi,... ,Xm„-\- 2 ^ with the subscripts matching their respective balls of containment. For notational convenience, 
define xq := a;init. Note that by construction of the balls, for i G {0,..., Mn + 1}, each pair of consecutively indexed 
points {xi, Xi+i) is separated by no more than < r„. Furthermore, since by equation ([^ above, there cannot 

be an obstacle between any such pair, and thus each pair constitutes an edge in the gPRM graph. Thus, we can upper-bound 
the cost Cn of the gPRM solution by the sum of the lengths of the edges (xg, Xi),..., xm„-i- 2 )' 

-^n + 1 / X 

Cn ^ ~ 2;i|| < (M„ -h 2)Rn < — --- ZIpT^Bn + ‘2.Rn 

i=0 " 

2^/71-!/'^ 1 

< c(cre) -f _ - 3 Yy 7 c((Te) + 2i?„ = c(cre) H-- -c{(Je) + 2i?„ 

e 

The second inequality follows from the fact that the distance between Xi and x^+i is upper-bounded by the distance between 
the centers of Bn,i and Bn,i+i (which is at most plus the sum of their radii (which is 2771 “^/'^). The last 

inequality follows from the facts that c(tTe) < (1 -f e/3)c* and equation ([^. □ 


Note that if gPRM using r„ > 2D(V) reports failure, then there are two possibilities: (i) a solution does not exist, 
or (ii) all solution paths go through corridors whose widths are smaller than 2 D{V). Such a result can be quite useful in 
practice, as solutions going through narrow corridors could be undesirable anyways (see [LaValle et al. 2004 Section 5] 
for the same conclusion). 

Next, we relate the solution cost returned by gPRM to the best cost of a path with strong ^-clearance in terms of the 
^ 2 -dispersion of the samples used. This is a generalization of previous convergence rates, e.g. | Janson et al. 2015) , which 
only apply to obstacle-free spaces. Previous work also defined convergence rate as, for a fixed level of suboptimality e, 
the rate (in n) that the probability of returning a greater-than-e-suboptimal solution goes to zero. In contrast, we compute 
the rate (in n) that solution suboptimality approaches zero. Lastly, previous work focused on asymptotic rates in big-0 
notation, while here we provide exact upper-bounds for finite samples. 


Theorem 2 (Convergence rate in terms of dispersion). Consider the simplified problem of finding the shortest feasible 
path between two points Xg and x f in Xpee, assuming that both the initial point and final point have already been sampled. 
Define 

5mw( = sup{(5 >0:3 a feasible a G T, with strong 6-clearance} 


and assume 6max > 0. For all 5 < 5max, let c^^l be the cost of the shortest path with strong 6-clearance. Let Cn be the length 
of the path returned by running gPRM on n points whose i 2 -dispersion is D„ and using a connection radius r^. Then for 
all n such that r„ > 2Dn and Cn < 6, 


Cn 


< 



2Dn \ 
r„ - 2Dn ) 


c 




(4) 
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Proof. Let as be a feasible path of length with strong 5-clearance. Construct the balls Bi,, Bm^ with centers along 
as as in the proof of Theorem (note we are not constructing Bm„+i or - 1 - 2 ), except with radii Dn and centers 
separated by a segment of as of arc-length r„ — 2D„. Note that Mn = /(r„ — 2D„)J. Then by definition each Bi 

contains at least one point Xi. Furthermore, each Xi is connected to Xi-i in the gPRM graph (because Xi is contained in 
the ball of radius centered at Xi-i, and that ball is collision-free), and Xf is connected to xm„ as well. Thus Cn is 

upper-bounded by the path tracing through xo,xi,..., Xm„ ,Xf: 


M„ 

Cn < ||a;i - ccoll -I- ^ -f \\xf - xmJ\ < Vn 

i=2 


Mr, 

Dn+'^rn + \\Xf 
2=2 


^ {MnCn ~ Dn) + 
= + 2DnMn < 



ip n 


2Dn) + Dj 


XM„\\ 


where the second and third inequalities follow by considering the farthest possible distance between neighboring points, 
given their inclusion in their respective balls. □ 

Remark 1 (Convergence rate in obstacle-free environments). Note that when there are no obstacles, Smax = 00 and 
= ||a;j — xq II for all 5 > 0. Therefore, an immediate corollary of Theoreir^^is that the convergence rate in free space 
of gPRM to the optimal solution is upper-bounded by 2Ll„/(r„ — 2Dn)for r„ > 2£)„. 

Remark 2 (Practical use of convergence rate). Theorem^provides a convergence rate result to a shortest path with strong 
5-clearance. This result is useful for two main reasons. First, in practice, the objective of path planning is often to find a 
high-quality path with some “buffer distance" from the obstacles, which is precisely captured by the notion of 6-clearance. 
Second, the convergence rate in equation 0 could be used to certify the performance of gPRM (and related batch planners) 
by placing some assumptions on the obstacle set (e.g., minimum separation distance among obstacles and/or curvature 
of their boundaries). For instance, consider a deterministic low-dispersion sequence with dispersion upper bounded by 
7 and assume one has time to plan on n samples. Choose = 2ij)y n~^Dj'Qrsome > 1 and choose Sq > (one 

can readily verify that such a choice of Vn satisfies the assumptions of Theorem [^. Then one can state the deterministic 
guarantee “For all planning problems where there exists a feasible Sg-clear path (see Figure^, the cost of the path 
returned is within a factor Xjff) — 1) of the cost of the best S^-clear path." For given values off) and one can therefore 
“certify” the performance of the planner for a desired target performance. An interesting avenue for future research is to 
use information about the curvature of the obstacles to quantify the difference between and the true optimal cost c*. 

Both the asymptotic optimality and convergence rate results can be extended to other batch planners such as Lazy-PRM 
or FMT*, as discussed in Section [ST] 

Lastly, we show that using a low-^ 2 -dispersion lattice sample set, an asymptotically-optimal (AO) version of gPRM can 
be run that has lower-order computational complexity than any existing AO algorithm, namely uj{n) instead of 0{n log(n)). 

Theorem 3 (Computational complexity with deterministic sampling). gPRM run on n samples arranged in a d-dimensional 
cubic lattice with connection radius r„ satisfying equation^has computational complexity 


o{ 


Ti^rt 


(5) 


Furthermore, as long as nr'^ ^ 0, the computational complexity is also 0{n?r'^). 

Proof. The algorithm gPRM has three steps: (1) For each sampled point x, it needs to compute which other sampled points 
are within a distance of x. (2) For each pair of sampled points within of one another, their connecting edge needs 
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Fig. 2. An example of a planning problem with a feasible tJo-clear path. For a given clearance parameter So and suhoptimality factor ip, 
one can readily determine the number of samples (and, hence, computation time) that is deterministically guaranteed to return a path 
whose cost is within — 1) of the cost of the best 5o-clear path, for all planning problems where a feasible Jo-dear path exists. 


to be checked for collision, and if collision-free, its edge-length needs to be computed. (3) The shortest path through the 
graph produced in steps (1) and (2) from the initial point to the goal region needs to be computed. 

The lattice structure makes it trivially easy to bound a point’s r„-neighborhood by a bounding hypercube with side- 
length 2rn, ensuring only 0{nr^) nearby points need to be checked for each of the n samples, so this step takes 
time. 

In step (2), one collision-check and at most one cost computation needs to be performed for each pair of points found in 
step (1) to be within r„ of one another. The number of such pairs can be bounded above by the number of sampled points 
times the size of each one’s neighborhood, leading to a bound of the form 0{n ■ fir'll). Thus step (2) takes 0{n?r'^) time. 

After steps (1) and (2), a weighted (weights correspond to edge lengths) graph has been constructed on n vertices with 
a number of edges asymptotically upper-bounded by n^r^. One more property of this graph, because it is on the cubic 
lattice, is that the number of distinct edge lengths is asymptotically upper-bounded by nr^. An implementation of Dijkstra’s 
algorithm for the single source shortest path problem is presented in | |Orlin et ah] |2010| with running time linear in both 
the number of edges and the number of vertices times the number of distinct edge lengths. Since both are 0{v?rf^), that is 
the time complexity of step (3). 

The space complexity is proportional to the number of edges plus the number of vertices, which are and 0{n), 

respectively. By assumption that nr„ ^ 0, 0{n^r!^) will be the (possibly co-) dominant term. □ 

Since Theorem [fallows r„ G while maintaining AO, Theoremj^implies that cubic-lattice sampling allows 

for an AO algorithm with computational and space complexity uj{n). All other AO algorithms in the literature have 
computational and space complexity at least 0{n log(n)). While the use of an G makes the graph construction 

phase (steps (1) and (2)) uj{n), step (3) would in general take longer, as shortest-path algorithms on a general graph with 
n vertices requires 0(nlog(n)). Thus the lattice structure must be leveraged to improve the complexity of step (3)—we 
discuss the limitations implied by this in the next section. 


5. Extensions 

In this section we discuss several extensions to the results presented in Section]^ In particular, we discuss extensions to 
alternative implementations and other types of batch-processing algorithms (Sections |5.1 | and [5^ , to non-uniform sampling 
sequences (Section [53]), and to kinodynamic motion planning (Section[53|). 
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5.1. Convergence Results for Other Batch-Processing Algorithms 

The theoretical convergence results of the previous section (Theorems and extend to alternative implementations of 
gPRM and other batch-processing algorithms. We first discuss a variant of gPRM which makes connections based on 
fc-nearest-neighbors instead of a fixed connection radius. This variant, referred to as fc-nearest gPRM, has the advantage of 
being more adaptive to different obstacle spaces than its connection-radius counterpart (we refer the reader to [Janson et al.| 


2015 Section 5.3] for a more detailed discussion about the relative benefits of a fc-nearest-neighbors implementation). 


Assuming that fc-nearest gPRM is implemented so that the number of neighbors kn (a function of n, as r„) is taken for 
each sample to be roughly connected to its r„-neighborhood if there were no obstacles, then deterministic asymptotic 
optimality and rate convergence guarantees can be readily derived. Specifically, assuming kn = (1 + e)nCdrn^ where e > 0 
and Q is the volume of the unit ball in d dimensions, then a graph constructed in fc-nearest gPRM with fc„ neighbors will 
asymptotically contain all the edges (and more) of the graph constructed in gPRM with radius r„, and thus will return a 
path at least as low-cost. 

A second example is Lazy-PRM [Bohlin and Kavraki]|2000| , where the extension of the theoretical convergence results 
is straightforward, as the path returned by Lazy-PRM is identical to that returned by gPRM (using the same radius). 

A third example is FMT* | Janson et al. 2015) . The only difference in the proof for FMT* from that for gPRM is that 
c„ cannot naively be upper-bounded by the length of a path tracing through a sequence of points in the gPRM graph, as 


FMT* may not use some edges. However, as shown in the proof of Lemma 4.2 (pages 912-913) in | Janson et al. 2015 


Appendix A], FMT* ’s c„ can be bounded by the length of a path tracing through a sequence of points in the gPRM graph 
if those points are contained in a suitable sequence of balls. In particular, the sequence of balls needs to be sufficiently far 
from obstacles and adjacent balls need to be sufficiently close together. It is easy to check that the sequences {Bi} used in 
the proofs of the previous section satisfy these conditions. 


5 . 2 . Complexity Results for Different Sampling Schemes and Other Batch-Processing Algorithms 

The complexity result in Theorem]^ strictly speaking, only applies to gPRM as defined in Algorithm [1] run on n samples 
arranged in a d-dimensional cubic lattice. Using other low-dispersion but non-lattice sampling schemes, such as the 
Halton/Hammersley sequence, would not give 0{nrf) distinct edge lengths, which precludes the use of the improved 
implementation of Dijkstra’s algorithm [ Orlin et S]|2010 |. A fc-nearest-neighbor implementation (where is selected as 
specified in Section 5.1 in order to ensure convergence), even on a lattice, would also no longer in general have 0{nrf) 


distinct edge lengths. Lastly, other batch-processing algorithms, such as FMT*, do not separate graph construction and 
shortest-path computation, again precluding, at least naively, the use of the improved implementation of Dijkstra’s algorithm. 

In all the above cases, all the same computational advantages stated in the proof of Theorem]^ would hold, except the 
advantage from the sped-up shortest-path algorithm in step (3). In practice the shortest-path algorithm is typically a trivial 
fraction of path planning runtime, as it requires none of the much-more-complex edge-cost and collision-free computations. 
In other words, the constant hidden in the big-O notation for the shortest-path algorithm is drastically smaller than that in 
the other steps. Thus, a practical approximation of the runtime could ignore the shortest-path component, in which case 
the result of Theorem[^can be extended to all of the aforementioned examples. 


5.3. Non-uniform Sampling 

A popular method for incorporating prior knowledge about a problem is to draw samples in a way that is not uniform 
throughout the configuration space. Increased sampling density in areas that are especially hard to traverse gives a motion 
planning algorithm help in that area. Thus if these areas can be identified a priori or even adaptively (see, for example, | |Boor| 
|et al.|[T999) ), observed convergence can be substantially sped up. Sampling non-uniformly in the i.i.d. setting is often fairly 
straightforward, for instance by simply adding sample-rejection rules to the uniform strategy | |Hsu etal.|[2006) . As long as 
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there remains a baseline density of samples everywhere in the space, similar worst-case (i.e., even if the non-uniformity of 
sampling was poorly chosen for the problem at hand) guarantees to the uniform case can still be made (see, for example. 


I Janson et al. 20151). The notion of density is less clear in the deterministic case, but we can fall back on the notion of 


f 2 -dispersion instead. Indeed, the theoretical convergence results in this paper are not specific to any deterministic sampling 
strategy, but simply make a requirement on the £ 2 -dispersion. Thus, many non-i.i.d., non-uniform sampling strategies fit into 
the analysis given here. Consider, for instance, using a sequence with £ 2 -dispersion upper-bounded by 777 ,“^/'^ to sample 
n/2 points, and then sampling n/2 more points in any way (e.g., biased towards sampling near obstacles). The resulting 
set of n points will have £ 2 -dispersion upper-bounded by and thus still be a low-£ 2 -dispersion sequence. There 

is a rich literature in different methods for non-uniform sampling, and an interesting future direction will be to investigate 
how best to adapt such methods to the deterministic context. 


5.4. Deterministic Kinodynamic Planning 

Another important extension is to motion planning with differential constraints. In particular, we consider here the extension 
to systems with linear affine dynamics of the form; x(f) = Ax(f) -f Bu{t) + c, where A, B, and c are constants. The 
extension of the £ 2 -dispersion-based analysis of this paper to that case poses some challenges. The key roadblock is that the 
£ 2 -dispersion is no longer a particularly accurate measure of how suitable a set of points is to track an optimal differentially- 
constrained path. Essentially, Euclidean balls must be replaced by “perturbation” balls | Schmerling et al. | |2015b| , which 
are high-dimensional ellipses. To be clear, by a high-dimensional ellipse we mean a volume defined by 


{a; : x^Qx < r} 


(6) 


for some positive-definite matrix Q and scalar r. Although such ellipses may be inner-bounded by a Euclidean ball, this 
(poor) approximation adds an exponential factor of the controllability index of the pair (A, B) \ Schmerling et al. 2015b) 
to the analysis. (Assuming the pair [A, B) is controllable, the controllability indices Vi give a fundamental notion of how 


difficult a linear system is to control in the various directions, see |Kailath 1980 p. 431] or |Chen 1995 pp. 150] for a 


detailed treatment. The number of controllability indices is equal to the number of control inputs, that is to the number of 
columns of B. The maximum, that is 1 / = max Vi, is referred to as the controllability index of the pair (A, B).) The following 
theorem (whose proof is largely based on the analysis framework devised in [Schmerling et al.||2015b[) summarizes the 


optimality result. Here gDPRM is just Algorithm 1 except that Near uses the cost in | Schmerling et al. 2015b equation 
( 2 )] instead of arc-length. 

Theorem 4 (Asymptotic optimality with deterministic sampling for systems with linear affine dynamics). Under 
the assumptions of [^Schmerling et al.\ 2015b Theorem VI.1], gDPRM with deterministic low-dispersion sampling is 
asymptotically-optimal for 

r„ = (7) 


for some constant Ci, while gDPRM with i.i.d. uniform sampling is asymptotically optimal for 

'n — ^2 


( 8 ) 


for some constant C 2 , where D = id-\-^i'f)/2, the Vi are the controllability indices of the pair (A, B), and v = max Vi. 


Proof sketch. Eor the sake of brevity, we only describe here the changes needed to the theory in | Schmerling et al. 2015b |, 
as the results have much in common. The proof of Q is nearly identical to that of [Schmerling et al.||2015b| Theorem 


VI. 1] except with a low-dispersion analogue of [Schmerling et al.||2015b[ Theorem IV. 6 ] which uses the same r„ rate as 
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in 0. To see this analogue result, note that [Schmerling et al.l |2015b Lemma IV.5] holds deterministically under low- 
dispersion sampling with the log term removed from the condition on the volume fJ,[Tk]. Then the proof of the analogue 
of I Schmerling et al. 2015b[ Theorem IV.6] only requires construction of the sets Sk (no T^), again without the log term. 
From the deterministic version of [ Schmerling et al.||2015b Lemma IV.5], we have that for the scaling of as in Q, 
every set Sk will contain a sample, and equation 0 follows. 

Finally, equation ([8]l is a direct corollary of [Schmerling et al. 2015b Theorem VI.l]. □ 


If V = I (i.e., all directions are “equally difficult” to control), deterministic sampling and our analysis show all the 
same benefits as in the case of the path planning (non-kinodynamic) problem by getting rid of the log(n) term required by 
i.i.d. sampling without changing the exponent (as in this case, vd = d and D = d). Note that a special case where = 1 is 
represented by the single-integrator model x(f) = u{t), which effectively reduces the kinodynamic planning problem to 
the path planning problem stated in Sectionjs]— in this sense, Theorem|7]recovers Theorem[^when x(f) = u(f). However, 
in general, the exponent for the case of deterministic low-dispersion sampling (i.e., the exponent in equation Q) may 
be worse. For instance, for the double-integrator model in three dimensions, namely x(f) = u{t) and d — 6, the three 
controllability indices are vi = V 2 = = 2. As a consequence, one obtains vd = 12 and D = 9, and the radius in 

equation (0 (i.e., for the deterministic case) is larger that the radius for equation ([^ (i.e., for the case with i.i.d. uniform 
sampling). 

This is not to say that deterministic sampling is necessarly inappropriate or not advantageous for differentially- 
constrained problems, but just that the analysis used here is inadequate (most critically, we crudely inner-bound ellipses via 
Euclidean balls). Our analysis does, however, suggest possible ways forward. One could consider a measure of dispersion 
which applies more specifically to ellipses, and possibly tailor a deterministic sequence to be low-dispersion in this sense. 
To our knowledge, no assessment of sample sequences in terms of this type of dispersion has been performed previously, 
and this represents a theoretically and practically important direction for future research (together with studying tailored 
notions of sampling sequences and dispersion for other classes of dynamical systems, e.g., driftless systems). 

We will further study kinodynamic motion planning via deterministic sampling sequences through numerical 
experiments in Section]^ 


6. Numerical Experiments 

In this section we numerically investigate the benefits of planning with deterministic low-dispersion sampling instead of i.i.d. 
sampling. Section [6T| overviews the simulation environment used for this investigation. Section [6]2] details the deterministic 
low-dispersion sequences used, namely, lattices and the Halton sequence. Several simulations are then introduced and results 
compared to i.i.d. sampling in Sections [63] and [6]4| Finally, we briefly discuss non-i.i.d., random, low-dispersion sampling 
schemes in Section 1631 

6.1. Simulation Environment 

Simulations were written in C-H-, MATLAB, and Julia j jBezanson et al.|[2012| , and run using a Unix operating system 
with a 2.3 GHz processor and 8 GB of RAM. The C-H- simulations were run through the Open Motion Planning Library 
(OMPL) j jgucan et al.j [2012) . The planning problems simulated in OMPL were rigid body problems, the simulations 
in MATLAB involved point robots and kinematic chains, and those in Julia incorporated kinodynamic constraints. For 
each planning problem, the entire implementation of gPRMwas held fixed (including the sequence of r„) except for the 
sampling strategy. Specifically, for all simulations (except the chain and kinodynamic simulations), we use as connection 
radius = 7 prm (log(n)/n)^/‘^, where 7 pr,m = 2.2 (l + \/dYi'^(l/C,d)^^'^ and C,^ is again the volume of the unit ball 


in d-dimensional Euclidean space. This choice ensures asymptotic optimality both for i.i.d. sample sequences [Karaman 
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and Frazzoli 201 1| Janson et al. 2015| and deterministic low-dispersion sequences (Theorem[^. Because this is an exact 


“apples-to-apples” comparison, we do not present runtime results but only results in terms of sample count, which have the 
advantage that they do not depend on the specific hardware or software we use. (Note that drawing samples represents a trivial 
fraction of the total algorithm runtime. Furthermore, as mentioned in the introduction, deterministic sampling even allows for 
possible speedups in computation.) The code for these results can be found at https : / / github . com/stanf ordasl, 


6.2. Sampling Sequences 


We consider two deterministic low-dispersion sequences, namely the Halton sequence | |Halton|['1960[ and lattices. Halton 
sampling is based on a generalization of the van der Corput sequence and uses prime numbers as its base to form a 
deterministic low-dispersion sequence of points | |Halton|| 1 960||LaV alle et al.]|2004| . Lattices in this work were implemented 
as a triangular lattice in two dimensions and a Sukharev grid in higher dimensions | |Sukhare^|1971) . 

Along with the benefits described throughout the paper, lattices also present some challenges [LaValle et al.|[2004| . 
First, for basic cubic lattices with the same number of lattice points k per side, the total number of samples n is constrained 
to k‘^, which limits the potential number of samples. For example, in 10 dimensions, the first four available sample counts 
are 1, 1024, 59,049, and 1,048,576. There are some strategies to allow for incremental sampling | Yershova and La Valle [ 
2004 Lindemann et al. 2005 Yershova et al. 2010|, but in this paper we overcome this difficulty by simply “weighting" 


dimensions. Explicitly, we allow each side to have a different number of lattice points. Independently incrementing each 
side’s number of points by 1 increases the allowed resolution of n by a factor of d, as it allows all numbers of the form 

n= {k-l)^{ky-^. 

Second, lattices are sensitive to axis-alignment effects, whereby an axis-aligned obstacle can invalidate an entire axis- 
aligned row of samples. A simple solution to this problem is to rotate the entire lattice by a fixed amount (note this changes 
nothing about the f 2 -dispersion or nearest-neighbor sets). We chose to rotate each dimension by IOtt degrees as an arbitrary 
angle far from zero (in practice, problems often show a “preferential” direction, e.g., vertical, so there may be an a priori 
natural choice of rotation angle). 

Finally, we include examples in SE(2) and SE(3) because they are standard, even though the cost function is no longer 
arc-length in the configuration space, but closer to arc-length in the translational dimensions. As this is technically outside 
the theory in this paper, we must consider an appropriate analogue of deterministic low-dispersion sampling. In the naive 
Sukharev lattice, each translational lattice point represents many rotational orientations. Eor instance, in SE(3), this means 
there are only k^ translational points when n = kS, providing a poor extension of the theory in this paper to the rigid body 
planning problem. A better approximate extension is to “spread” the points, which entails de-collapsing all the rotational 
orientations at each translational lattice point by spreading them deterministically in the translational dimensions around 
the original point. An example of this process with one rotational and two spatial dimensions is shown in Eigure A 
similar phenomenon occurs with kinodynamic sampling, in which case it is beneficial to spread velocity samples. Eor the 
double-integrator model, as shown in Eigure]^ this process entails offsetting velocity samples from their original positions 
by an amount proportional to their velocities. To then reduce unfavorable structure between neighboring lattice points and 
increase variation in connection types, alternating samples were rotated 180 degrees for the final implementation in Eigure 


6.3. Simulation Test Cases 

Within the MATLAB environment, results were simulated for a point robot within an Euclidean unit hypercube with a 
variety of geometric obstacles over a range of dimensions. Eirst, rectangular obstacles in 2D and 3D were generated with a 
fixed configuration that allowed for several homotopy classes of solutions. A 2D maze with rectangular obstacles was also 
created (Eigure [5(a)]l. These sets of rectangular obstacles are of particular interest as they represent a possible “worst-case” 
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Fig. 3. Figure |3(a)| Rectangular rigid body lattice samples with one rotational and two spatial degrees of freedom. Figure |3(b)| A 
“spread” lattice formed by spreading the different rigid body orientations spatially around the original point results in a better spatial 
coverage of the configuration space. 



\ \ t / 
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(a) (b) (c) 

Fig. 4. Figure [4(^ A lattice for the double-integrator model with two spatial and two velocity degrees of freedom. Figure [4(b)l A 
“spread” lattice formed by offsetting the velocity samples from their original positions (by an amount proportional to their velocities) to 
obtain better spatial coverage. Figure [4(c)l The same lattice with alternating samples rotated 180 degrees to increase variation in types 
of connections and reduce unfavorable structure (this implementation was used for our results). 


for lattice-based sampling because of the potential for axis alignment between samples and obstacles. The results, shown 
for the 2D maze in Figure]^ and for all experiments in Table [T] show that Halton and lattice sampling outperform i.i.d. 
sampling in both success rate and solution cost. 

To illustrate planning with rectangular obstacles in higher dimensional space, we constructed a recursive maze obstacle 
environment. Each instance of the maze consists of two copies of the previous dimension’s maze, separated by an obstacle 
with an opening through the new dimension, as detailed in [Janson et al.| |2015| . Figure |6(a)| shows the maze in 2D and 
Figure [6(b)] shows the maze in 3D with the two copies of the 2D maze in black and the opening in red. Halton and lattice 
sampling conferred similar benefits in the recursive mazes in 2D, 3D, 4D, 5D, 6D, and 8D as they did in other simulations 
(see Table[2l. 

Along with the rectangular obstacles, hyperspherical obstacles within a Euclidean unit hypercube were generated to 
compare performance on a smooth obstacle set with no possibility of axis alignment between samples and obstacles. The 
setups for 2D and 3D (Eigures |6(c)| and |6(d)[ ) were fixed, while in 4D, obstacles were randomly generated to match a 
specified spatial coverage. Again, Halton and lattice sampling consistently outperformed random sampling, as shown in 
Tabled 
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2D Maze Obstacle 2D Maze Obstacle 



Fig. 5. Figure [5(^ The planning setup for a point robot with rectangular obstacles in a 2D maze. Figures [5(b)| and [5(c)| The results for 
solution cost and success rate versus sample count (averaged over 50 runs). For clarity we only report data for i.i.d. sampling and lattice 
sequences, results including Flalton sampling are reported in Table[T] Only points with greater than 50% success are shown in Figure 

ES] 


As an additional high-dimensional example, an 8D kinematic chain planning problem with rotational joints, eight links, 
and a fixed base was created (Figure [6(e)) l. The solution required the chain to be extracted from one opening and inserted 
into the other, as inspired by [Lindemann et al.[|2005[ . The chain cost function was set as the sum of the absolute values of 
the angle differences over all links and the connection radius was thus scaled by s/dit. With this high dimension and new 
cost function, the Halton and lattice still perform as well as or better than i.i.d. sampling (see Table0. 

Within the OMPL environment, rigid body planning problems from the OMPL test banks were posed for SE(2) and 
SE(3) configuration spaces. In the SE(2) case, one rotational and two translational degrees of freedom are available, resulting 
in a three dimensional space, shown in Figure [6^ The SE(3) problem consists of an “L-shaped" robot moving with three 
translational and three rotational degrees of freedom, resulting in six total problem dimensions, shown in Figure [6(^ As 
already mentioned, the rigid body planning problems are not strictly covered by the theory in this paper, and thus the SE(2) 
and SE(3) lattices use the spreading method described in Section [6^ The results, summarized in Table[T] show that Halton 
and lattice sampling generally outperform i.i.d. random sampling. 

Lastly, planning problems with kinodynamic constraints were simulated within the Julia environment using the gDPRM 


algorithm defined in Section p^ with reference to | Schmerling et al. 2015b |. The connection radius was computed using 
equation ([8]l in Theoremj^ First, a double-integrator model with two spatial dimensions and two velocity dimensions was 
posed to simulate a system with drift (Figure [6(hj| ). To obtain better spatial coverage, the lattice was spread as described in 
Section [6^ Second, results were simulated for the Reeds-Shepp car system [Reeds and Shepp[|1990) , a regular driftless 
control-affine system with one rotational and two translational degrees of freedom (Figure [6(h)| l. The Reeds-Shepp car is 
constrained to move with a unit speed (forwards or backwards) and turn with a fixed radius. Although these dynamics are 
different from those discussed in Sectionwe can still define gDPRM with respect to | Schmerling et al.| 2015a| and 
evaluate the benefits of deterministic low-dispersion sampling. Again, spreading was used in the spatial dimension. With 
the addition of kinodynamic constraints, the Halton and lattice sampling continue to outperform i.i.d. random sampling, as 
summarized in Table [1] 


6.4. Summary of Results 

Table [T] shows a summary of the results from simulations detailed in Section |6.3| Results are shown normalized by the 
i.i.d. sampling results. In each case the sample count at which a success rate greater than 90% is achieved and sustained is 
reported. Additionally, the solution costs at a medium and high sampling count are shown. For all cases the lattice sampling 
finds a solution with fewer or an equal number of samples and of lower or equal cost than that found by i.i.d. sampling. The 
Halton sampling also always finds a solution at lower sample counts than i.i.d. sampling, and almost always finds solutions 
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Fig. 6. Images of the recursive maze planning problem in 2D l |6(a)^ and 3D l |6(b)[ > and the spherical obstacle sets in 2D l |6(c)^ and 3D 
l |6(d)[ (. Also shown are an 8D kinematic chain planning problem in |6(e)| and the OMPL rigid body planning problems for SE(2) and 
SE(3) in |6(f)| and |6(g)| respectively. Lastly, [6(h)| shows the setup for the double-integrator and Reeds-Shepp car. Note that the problems 
in |6(h)| have kinodynamic constraints, where we are not only considering straight line connections, but ones with curvature. A summary 
of results can be found in Tabled 


of lower cost as well. The deterministic low-dispersion sequences particularly outperform random sampling in terms of 
number of samples required for a 90% success rate. 


6.5. Nondeterministic Sampling Sequences 

The above simulations showed deterministic lattice sampling, with a fixed rotation around each axis, and the deterministic 
Halton sequence outperform uniform i.i.d. sampling. Both deterministic sequences have low f 2 -dispersions of 
but sequences with the same order ^ 2 -dispersion need not be deterministic. Figure|^shows results for a randomly rotated 
and randomly offset version of the lattice (again, the f 2 -dispersion and neighborhoods are all still deterministically the 
same). The same cases in Table[^were run for the randomly rotated lattice and the results showed it performed as well as or 
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Halton Lattice 


Dim 

Obstacles 


90% Success 

Medium 

High 


90% Success 

Medium 

High 

2 

Rectangular 


38% 

118% 

80% 


15% 

56% 

80% 

3 

Rectangular 


36% 

88% 

94% 


19% 

80% 

87% 

2 

Reel Maze 


13% 

98% 

99% 


13% 

100% 

99% 

2 

Sphere 


16% 

93% 

99% 


7% 

93% 

99% 

3 

Sphere 


36% 

97% 

100% 


8% 

97% 

99% 

4 

Sphere 


100% 

97% 

97% 


100% 

97% 

100% 

2 

Recursive Maze 


33% 

100% 

100% 


18% 

100% 

100% 

3 

Recursive Maze 


22% 

95% 

99% 


22% 

96% 

98% 

4 

Recursive Maze 


56% 

95% 

98% 


56% 

100% 

100% 

5 

Recursive Maze 


45% 

97% 

96% 


60% 

95% 

96% 

6 

Recursive Maze 


56% 

95% 

97% 


75% 

94% 

96% 

8 

Recursive Maze 


56% 

98% 

99% 


75% 

99% 

99% 

8 

Chain 


67% 

112% 

91% 


7% 

76% 

87% 

3 

SE(2) 


81% 

96% 

100% 


81% 

101% 

101% 

6 

SE(3) 


32% 

96% 

93% 


42% 

94% 

95% 

4 

Double-Integrator 


53% 

90% 

93% 


30% 

92% 

96% 

3 

Reeds-Shepp Car 


44% 

97% 

99% 


44% 

98% 

100% 


Table 1. Summary of results. Each entry is divided by the results of i.i.d. sampling (averaged over 50 runs). For Halton sampling and 
lattice sampling, the number of samples at which 90% success is achieved and the cost at a medium number of samples (near 700) and 
a high number of samples are shown (highest samples simulated, always 3000 or greater). Note that nearly all table entries are below 
100%, meaning the Halton and lattice sampling outperformed i.i.d. sampling. 


better than random sampling (over 50 runs). In general, low-dispersion random sequences might provide some advantages, 
e.g., eliminating axis alignment issues while still enjoying deterministic guarantees (see Section |^. Their further study 
represents an interesting direction for future research. 


2D Maze Obstacle 



(a) 


2D Maze Obstacle SE(3) Maze 




(b) (c) 


Fig. 7. Results for deterministic and nondeterministic low-dispersion sampling. “Rand Rot Lattice” refers to a randomly rotated lattice. 


7. Conclusions 

This paper has shown that using low-dispersion sampling strategies (in particular, deterministic) can provide substantial ben¬ 
efits for solving the optimal path planning problem with sampling-based algorithms, in terms of deterministic performance 
guarantees, reduced computational complexity per given number of samples, and superior practical performance. 

This paper opens several directions for future research. First, we plan to deepen our study of deterministic kinodynamic 
motion planning, in particular in terms of tailored notions of sampling sequences and dispersion and more general dynamical 
models. Second, it is of interest to extend the results herein to other classes of sampling-based motion planning algorithms 
(beyond the ones studied in this paper), especially the large class of anytime algorithms (e.g., RRT/RRT*). This leads directly 
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into a third key direction, which is to study alternative low-dispersion sampling strategies beyond the few considered here, 
particularly incremental sequences for use in anytime algorithms. There is already some work in this area, although thus 
far it has focused on the use of such sequences for the feasibility problem [Yershova and LaValle| |2004| |Lindemann| 

2010| . It may also be of interest to study low-dispersion sampling strategies that incorporate 
prior knowledge of the problem by sampling non-uniformly, as discussed in Section |5.3| Fourth, we plan to investigate 
the topological relationship between the optimal path cost and that of the best strong-(5-clear path, in order to frame the 
convergence rate in terms of the true optimal cost. Fifth, from a practical standpoint, it is of interest to adapt existing 
algorithms or design new ones that explicitly leverage the structure of low-dispersion sequences (e.g., fast nearest neighbor 
indexing or precomputed data structures). This would be especially beneficial in the domain of kinodynamic motion 
planning. Finally, leveraging our convergence rate results, we plan to further investigate the issue of certification for 
sampling-based planners, e.g., in the context of trajectory planning for drones or self-driving cars. 


et al. 2005 Yershova et al. 
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